geometry_msgs/Pose stop_pose
geometry_msgs/Point[] stop_factor_points
